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ABSTRACT. Complicated systems with non-linear time-varying behavior are 
difficult to control using classical linear feedback methods applied 
separately to individual degrees of freedom. At the present, mechanical 
manipulators, for example, are limited in their rate of movement by the 
inability of traditional feedback systems to deal with time-varying 
inertia, torque coupling effects between links and Coriolis forces. 
Analysis of the dynamics of such systems, however, provides the basic 
information needed to achieve adequate control. 

Implementation of a control system based on such analysis is 
not straightforward, however, since impractical amounts of computation 
or memory may be called for. We propose a new method that balances the 
trade-off between computational and storage costs. The actuator torques 
required to move a manipulator along a trajectory are calculated using 
coefficients found in a look-up table indexed by the configuration of 
the manipulator. Feedback plays only an indirect role in correctinq for 
small differences between the state of the actual device and that of a 
dynamic model. 
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MOTIVATION. 

The application of industrial manipulators to parts transfer is still 
limited by their high cost. A useful figure of merit for such a device is 
the ratio of the number of operations it can perform per unit time to its 
cost. The more cycles the manipulator performs per unit time, the 
more rapidly it will pay back the investment. There is, we believe, a 
threshold for this figure of merit above which the application of 
machine manipulation to a wide variety of tasks becomes economically 
feasible. If the figure of merit were to rise above this threshold, the 
increase in feasibility would make mass production of manipulators 
possible, resulting in further drops in unit cost and yet wider application. 

It is unlikely that this revolutionary sequence of events will be 
triggered by a reduction in the cost of manipulators, since the technology 
for building reliable devices in the numbers now used appears fairly stable. 
It is possible, however, to decrease task cycle times with equally dramatic 
results. Decreasing cycle time means increasing the rate of manipulation — 
the speed the arm moves during transfer and during manipulation. 

Presently, many mechanical manipulators are limited by their controllers, 
Such systems typically employ simple, fixed analog servo loops closed 
separately around each degree of freedom. Though suitable for control of 
a set of independent second-order systems with fixed inertias and damping, 
such control is not appropriate for devices with non-linear, time-varying 
behavior. Performance is adequate at low speeds provided the actuators are 
strong enough and the properties of the devices do not change too dramatically 
with configuration. At higher speeds, however, problems are caused by: 
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(1) Varying effective moments of inertia, 

(2) Torque coupling between degrees of freedom, and 

(3) Coriolis forces proportional to velocity product terms. 

Naturally, other factors, such as the mechanical strength of the device 
and the power available from the actuators, also limit ultimate performance. 
For many manipulators, however, these are not the limiting factors. 
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BACKGROUND. 



Mechanical manipulators used for parts transfer typically consist of 
rigid components, called links, attached to each other at joints, each joint 
being powered by an actuator (see for example figure 1). Measurements of 
joint position and velocity are available to the control system that 
supplies commands to the actuators. Most commonly, manipulators are attached 
to a fixed base at one end and carry a terminal device or tool at the other. 
The time- varying actuator commands are intended to cause this terminal device 
to follow a given trajectory through space. 

Many arrangements of links and joints are possible; in this paper, we 
concentrate on a kinematic chain arranged in a popular serial or cascaded 
/~s structure using rotary joints. This choice allows us to be concrete and 

to avoid repeated use of phrases such as "joint-angle or joint-extension" 
and "actuator torque or actuator force". Similar methods apply to devices 
with linear motions and to those with parallel degrees of freedom. 

The particular device shown in figure 1 was designed and built by 
Victor Scheinman for the Artificial Intelligence Laboratory [1]. it has 
six degrees of freedom, the minimum necessary to reach points in the work 
space with arbitrary orientation of the terminal device. This manipulator 
is driven by six direct current torque motors, and has potentiometers for 
joint-angle measurement and tachometers for joint-angle-rates or angular 
velocities. The supporting electronics permit direct control of motor currents 
and, consequently, actuator torques. 
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We designate 8. the angle of the i joint, and 6. the angular velocity 
of this joint. Similarly, 8. is the angular acceleration and T. the torque 
applied by the i actuator- Frequently it is helpful to group values for 
all degrees of freedom using vector notation. Thus for a system with n 
degrees of freedom, we call 6 the configuration, where: 



e = (e r e 2 , e 3 , .... e n ) 



Similarly, we refer to the combination of 6 and 8 as the state, where: 



8- (8-19 8p, 8~, .... 8) 
The torque vector is similarly defined as 



T - (T-j, I2 9 *3 5 •••• T ) 



With this notation we see that the function of the control system is to 
produce appropriate actuator torques T(t), so that the actual joint 
angles, 8 a (t), follow a given trajectory of desired joint angles, 8 (t) 
(see figure 2). We will see later that this task may at times be simplified 
if the control system also has access to both actual angular velocities, 
8 a (t), as well as desired angular velocities, 8 (t). 
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A SYSTEM WITH ONE DEGREE OF FREEDOM. 

To introduce some of the notions used later on, let us consider a very 
simple system illustrated in figure 3 — a one degree-of- freedom 
"manipulator". Here a motor produces a torque, T, which drives a shaft. The shaft 
carries a rod of mass m and length z. The angular departure from vertical, e, 
is measured by a potentiometer, while a tachometer measures the angular 
velocity, e. Clearly the system is governed by an equation of the form 

T = I 8 - k sln(e) 

where I = mi /3, g is the acceleration due to gravity and k = (m£/2)g. 

A typical control system for such a second-order system is shown in figure 4. 

Here, 



T = 3 (e d - e a ) + a (e d - e a ) 



where the superscripts denote desired and actual values, while a and $ 
are parameters yet to be determined. Combining the two equations we find 

I e a + b e a + (a e a - k sin(e a )) = b e d + a e d 

If the actual angle, a , is to follow the desired angle e d closely, a » k. 
In this case, the poles of the system are approximately at the roots of the 
polynomial 



I s 2 + e s + a = 
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That is, 

- 8 ± / B 2 - 4 a I 



s = 

2 I 



The speed of response of the overall system depends on / a / I ; so, for 
rapid response, a should be large. 



( 



To obtain good damping of transient oscillations, we choose 3 so that 
e - 2 / a I. The details of this are not very important other than to 
show that such feedback systems can achieve adequate control of simple 
second-order mechanical systems and that the parameters of the feedback 
system must be chosen by considering the parameters of the system itself. 
When system parameters change, a different set of feedback parameters 
is used to provide best performance. 

If the parameters of the system vary greatly and the control system 
is not altered, unsatisfactory performance can be anticipated. This may 
take the form of sluggish response, excessive overshoot, or undamped 
oscillations. 
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INVERSE SYSTEMS. 

Analysis of the dynamics of a system often leads to equations that can 
be used to implement an "inverse" system. The system originally analyzed 
can be viewed as an analog computer for calculating position (and its 
derivatives) given actuator outputs, while the inverse system computes 
actuator outputs from position (and its derivatives). A simple illustration 
will make this clear. 

A one degree-of- freedom system was shown in figure 3, governed by the 
equation 

I 6 - k sin(e) = T 

This system can be viewed as an analog computer solving this differential 
equation for e(t), given the input T(t). If the constants in the equation 
are known, one can turn this analysis around and calculate the values of 
torque, T(t), needed to achieve the desired joint-angle variations with 
time, e(t). This inverse procedure is important in solving the control 
problem. An open-loop control system based on this notion is shown in 
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figure 5a. We will take up later the question of errors in trajectory 
which result from small differences between the actual system and the 
model used in deriving the inverse system. For now, note that in view 
of this possibility the actual state of the system should be used in 
the inverse calculation rather than the desired state (see figure 5b). 
With this modification, the inverse system takes as its prime input the 
angular acceleration, and produces actuator torque as its output. 

The straightforward kind of control based on an inverse system and il- 
lustrated here applied to a linear, time-invariant, one degree-of-freedom 
system, will now be extended to control of more complex systems such as 
manipulators. Before we can do this, we have to understand the dynamics 
of these devices. Considerable work has been done in this area as can be 
seen from references [2, 3, 4, 5, 6, 7, 8] for example. 
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DYNAMICS OF MANIPULATORS . 



The most direct route leading to a detailed understanding of the dynamics . 
of a complex mechanical system such as a manipulator is an analysis based on the 
Euler-Lagrange equations [8], 



^ dt hq. } 9q . 



Here the q. represents generalized coordinates, Q. generalized forces and L 1j 
the Lagrangian, or "kinetic potential", 



L = K 



where K is the kinetic energy and P the potential energy of the whole system. 
In our case the most convenient generalized coordinates are the joint-angles, 
e., and then the generalized forces become the actuator torques T.. Further- 
more, since the potential energy is a function of joint-angles only, it is con- 
venient to separate the calculation of torques required to compensate for gravi- 
tational forces, 

T , . 9P 

i " 39. 

from the calculation of torques required to support the motion if gravity were 
not present 



i dt V 96. ; " 96. 
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Also, since the total kinetic energy is the sum of the kinetic energies of 
each of the links, it is helpful to separate the calculation into components 
of the form, 

d3K. 8K. 
, = _ (_j.\ i 

ij dt ^6^' 39 i 
where T.. is the torque required of the i actuator to support the motion of 

■f"h 

the j link. The total torque required at each actuator is then obtained by 
summation of these terms. 

The derivation of the Euler-Lagrange equations requires difficult mathe- 
matical arguments; however the use of these equations is straightforward. 
Application of these equations to manipulator control was pioneered by Uicker 
Pieper, Kahn and Paul [5, 6, 7, 8j. A practical difficulty is the potentially 
explosive growth in algebraic manipulation that accompanies analysis of 
systems with several degrees of freedom. A computer system such as MACSYMA 
[9], able to carry out manipulations of symbolic mathematical expressions is 
very helpful in these cases. 

Much of the earlier work on this problem made use of a general representa- 
tion, with a coordinate system erected in each link and matrices describing 
the transformations between coordinate systems of connected links [5, 6, 7, 8]. 
While perfectly general, this kind of analysis leads to very complicated re- 
sults and the need to perform thousands of arithmetic operations in order to 
calculate required joint-torques. All hope of performing these calculations 
in real-time was abandoned as a result. 
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ILLUSTRATION USING THE SINGLE DEGREE-OF-FREEDOM SYSTEM. 



For the system shown in figure 3, it is clear that K = 1 Ie 2 and P = k cose, 



so that 



L = j IQ 2 - k cose 



Consequently, 



" dt l ae ; " ae 



gives us 



T = Ie - k sine 

as before. Here, of course, little is gained by using this method. It is, 
however, invaluable for complex devices. 
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DYNAMICS OF A THREE-LINK DEVICE. 

Recent work has shown that some devices can be analyzed easily if cal- 
culations use joint-angles directly and if links are modelled as thin rods [10, 
11, 12, 13]. As an example, we present the results for a tl)ree-link device 
with offsets shown in figure 6. This corresponds to the first three joints 
of the arm discussed earlier, shown in figure 1. 

T 1 = [I-, + m 2 (fi| + y- s|) + m 3 (£2 s 2 + 4 2 & 3 s 2 s 23 .+ y- s| 3 + 6|)] 8^ - 



TW^f'^zV *3 C 23 )] 9 2 



[ 2- 6 3 £ 3 C 23 ] *3 + 

[m 2 -^ s 2 c 2 + m 3 (2«,2s 2 c 2 + * 2 * 3 (c 2 s 23 + s 2 c 23 ) + -y- s 23 c 23 ] e^ + 



m m~ . . 

Cr 6 2*2 S 2 + F- 6 3 (2 *2 S 2 + £ 3 S 23 )] 9 2 + £ m 3 6 3 £ 3 S 23 ] 9 2 9 3 + 



2a 



^ 6 3*3 S 23 ] 9 3 + CV3 C 23 (£ 2 S 2 + ~T S 23 )] 9 3 9 1 
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m 2 , . A m 3 



T 2 - -[3- « 2 £ 2 c 2 + ^ 6 3 (2£ 2 c 2 + V23 )] V, + 



[m 2 3- + m 3 (^ + £ 2 * 3 c 3+ /)]e 2 + 



m 3 2*2 

[tj- (VqC, + -^)]e, - 



£ 2 . . . m 3 ,„., . .2*2 



2 V *2*3 U 3 "T"' J0 3 

£ 2 m 3 

[m 2 r s 2 c 2 + r (2*2s 2 c 2 + V3 (c 2 s 23 + s 2 c 23 ) + -/ s^j tf? 

[m 3 £ 2 £ 3 s 3 ]e 2 e 3 - [f i^sj e§ - 
Cm 2 2- s 2 + m 3 U 2 s 2 + ^ s 23 )]g 



T 3 - -[/ 53 , 3 c 23 ] ^ + [/ (, 2 , 3 c 3 + _!)] V 2 + [B3 _3je 3 



/-\ 



Z 2 . . , *3 

m~ 

r— 

L 2 

r m 3 , 2 h m, 

[ 2~ £ 3 C 23 (£ 2 S 2 + "T s 23^ef + [^ ^^ ] e£ - 



* 3 
[m 3 2- s 23 ] 9 



Here V ^ ^ are the lengths Qf the ^ ^ ^ ^.^ ^^ ^ 
modelled as a cylinder with inertia I, about its axis, while the other two links 
are modelled as thin rods of mass m, and m, respectively. An offset of 6 
occurs between the long axis of the upright column and the plane in which the 
second link rotates. A similar offset ^ separates the plane in which link 3 
rotates from this vertical axis (see figure 6). 
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A shorthand notation is used for trigonometric terms. That is, 
e. = cos(e.) Si = sin (e.) 

and 

c ij = cos ^ 8 i + V s ij = sin ( e i + 9 j) 

The terms containing e^ , e 2 or 8- are inertial torques (required to ac- 
celerate the links), while terms containing angular velocity products of the 
form e^.e. are Coriolis force components. The third class of terms contain g, 
the gravitational constant, and are thus the torques required to compensate 
for the gravitational load. 

Roughly a hundred arithmetic Operations are required to calculate the re- 
quired joint torques given joint angles, e, and angular rates, e, as well as 
desired accelerations, e\ Such a direct calculation might be used as the 
basis of a control system. In fact, if 6 2 and 6~ are zero, several tefrtis 
fall out and the calculation becomes simpler. If, on the other hand, 
we consider a device with either more degrees of freedom or links that have to 
be modelled by full inertia matrices, instead of the diagonal form appropriate 
to thin rods, then these calculations become quite intractable (For an example, 
see appendix A in reference [7] J. 
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WHY THE STRAIGHTFORWARD CONTROL METHOD FAILS. 

If we look at the equations for the actuator torques we see that they 
have some characteristics that make control more complex than it is for a 
simple one degree-of- freedom second-order system. First of all, the 
coefficients of e. in the expression for T 1 are not constant, indicating 
variable effective inertia. Ordinarily, as we have seen, the feedback 
coefficients are constants tuned for proper operation at some fixed inertia, 
so control will not be good for inertias very different from this design 
value. 

Next, one sees that there are terms containing e. in the expressions 
for T.j, when i f j. This cross-coupling, too, may produce problems since 
accelerations of one joint require coordinated torques at all joints. Loops 
closed separately around each joint cannot easily deal with this problem. 

Finally one sees numerous Coriolis force terms, multiples of products 
of joint-angle-rates. At high speeds, these dominate the inertia! and 
gravitational torques, and actuator torques produced by traditional 
control systems may not be appropriate for stable control. Such problems 
become most significant for long movements, when velocities can build up 
to a point where velocity product terms exceed acceleration terms. 
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FORM OF THE EQUATIONS OF MOTION. 

We now examine the form of the equations for the actuator torques in 
an attempt to find a reasonable computing scheme for control of such a 

device. Clearly each torque is a function of joint angles, e, angular 

• •• 

rates 6, and angular accelerations, 6. One approach then is to calculate 

the required actuator torques directly from the equations; techniques 
used by Paul are similar to this [8]. In most cases, however, this approach 
involves an inordinate amount of computing time and drastic simplifications 
have to be introduced to make this at all feasible [8]. 

The other extreme is based on a look-up table indexed on 6, 6 and 6. 
Each of the dimensions is quantized into m intervals. No calculation is 
required, but the look-up table has 3 n dimensions for a device with n 
degrees of freedom and is thus quite unmanageable even when each dimen- 
sion is quantized coarsely, that is, when m is small. If we use the 
convention that subscripts correspond to variables with discrete sets of 
values, then we may represent this scheme by the equation 



T. = F. / • '\ 

1 i,(e,e,e) 



where the values of F. are pre-calculated for a discrete set of values of 
6, 9 and 9, and stored in a table [14]. Albus' manipulation scheme is 
similar to this [IS]. 

Fortunately, however, the torques are linear functions of the 
accelerations, as we have seen, and the equation can be rewritten in the 
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form 



Tj = K.(<3,e) + I i (e.ej'e. 
j = 1 1J J 

This leads to a second implementation, using one look-up table for K. and one 
for I.., both indexed on 5 and e. These tables are now only of dimension 2n. 
The computation required after table look-up is simple, namely n multiplications 
and additions per joint. Raibert's manipulator control schemes are based on 
a similar formulation of the problem [16,1 7j. He derives the table entries by 
"learning" rather than calculation from the model — that is, the manipulator 
performs test motions to estimate experimentally the multipliers K. and I... 
In general the look-up tables are still too large to be useful. (In the 
equation above, the inertia! terms 1^. are written as functions of both angles 
and angular rates to indicate the indexing of look-up tables in this scheme. 
In fact, the inertial terms do not depend on the angular rates, something we 
will exploit next.) 
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CONFIGURATION SPACE CONTROL. 

It turns out that the equations have a rather special form [8, 10] and can 
be written as 

This is a consequence of the form of the express ion's for the Lagrangian. 
Here, G. is the gravity compensation, I., are inertia! terms and C... are 
Coriolis force coefficients. Each of these is a polynomial in the sines and 
cosines of the joint-angles, the link lengths and masses. Clearly these 
could be pre-calculated and stored in lookup tables indexed on 0. Such tables 
would be of dimension n and thus manageable in terms of storage space. A 
little more calculation is required; namely, n(n + l)/2 + n multiplications 
and n(n+l)/2+n additions per joint. We call this method configuration space control , 
since the look-up table is indexed on 6, the configuration of the manipulator. 
We should immediately add, that while nominally there are n dimensions 
in configuration space, some economy of storage is possible by noting that the 
I., and C... terms are not functions of the position of the first joint; that 
connecting the manipulator to its base. If in addition the axis of this joint 
is parallel to the gravity vector (as is often the case), the G.. term is also 
independent of the position of the first joint. Furthermore, if the important 
masses in the last, or highest numbered link, the terminal device, are 
symmetrically distributed, then the equations of motion do not depend on the 
position of the last joint either. If both these conditions are true, the stored 
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tables need only be of dimension (n - 2), a considerable saving. Further 
simplifications may apply to specific classes of manipulators. 

Similarly, the storage required per table entry can be economized 
when it is realized that the inertia matrix is symmetric, that only the 
upper half of the Coriolis force coefficient matrix is needed, and that 
there exist relationships between the coefficients C. and C...[4]. It takes a 

I J K K J 1 

little more work to exploit the fact that for a given manipulator geometry 
many of these coefficients are actually zero, or so small as to be negligible, 
as can be seen from the equations we presented earlier for a three link 
device (where only 10 of a possible 18 terms jvere non-zero). 

We have now explored a spectrum of methods for computing the required 
joint torques (see figure 7). It is our contention that both ends of the 
spectrum represent techniques which are impractical and that the configuration 
space method provides a near optimum balance between storage and computational 
costs. Note for example that state space control requires more storage capacity 
than configuration space control for any system with n > 1 and m > 1 . 

The notions of the inverse system and configuration space look-up 
can now be brought together in an overall system like that shown in figure 8. 
If one does not take advantage of the economies mentioned above, then 
about n (n + 3)/2 multiplications and additions are required per calculation 
cycle. If each dimension is quantized into m sections, then the look-up 
table has a total of [n(n+l )(n+2) / 2] m n numeric entries. These numbers are large, 
but manageable, especially in view of recent trends in the cost of computer 
storage. 
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MISMATCHES BETWEEN THE DYNAMIC SYSTEM AND THE MODEL. 

Glancing at figure 8, one notices that the input to the system is the 
angular acceleration, presumably supplied by a trajectory planner. 
Intuition suggests that such a system is likely to suffer from the ill 
effects of approximate numerical differentiation and in general behave 
in a fashion that has the actual joint-angles drifting away from the 
desired joint angles. The rate of accumulation of errors will depend on 
how accurate an inverse one can build to the dynamic system. For low 
speed movement it appears that the limiting factor in this regard will 
be friction, which tends to be both difficult to predict and not a 
repea table function of joint angles and angular velocities. This suggests 
that we have to augment the elegant open-loop system with sub-systems 
capable of correcting for small departures of the actual trajectory from 
the desired one. 

Some form of negative feedback is needed. Note, however, that 
feedback plays quite a different role here than it did in the simple 
control system shown earlier for a second-order dynamical system. In 
that situation, feedback produces the actuator forces; error signal are 
in some sense the prime movers. Here feedback is added only to correct 
for minor departures of the dynamical system from the model used in 
deriving the inverse system, with the main component of actuator torque 
coming from the open-loop calculation. For this reason the design of this 
feedback system is much less critical, with small feedback gains acceptable 
and consequently there need by little concern over stability. 
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INTRODUCTION OF CORRECTIVE FEEDBACK 

There are a number of alternate ways of introducing feedback to 
correct for the departures of actual position discussed in the previous 
section. Perhaps the most obvious has corrections proportional to the 
errors applied to the inputs of the dynamic system (see figure 9). That 
is, the actuator torque now is the sum of the calculated open-loop torque 
required to follow the trajectory and terms proportional to errors in 
position and velocity. Such a system would differ from the traditional 
control system in that the input is first passed through the inverse sys- 
tem and that the feedback gains would be much smaller. To some extent, 
this kind of system would however suffer from some of the short-comings 
of the traditional system, unless these feedback gains were at least ad- 
justed according to the current configuration. 

If suitable costs can be associated with departures from the correct 
trajectory and if costs can be assigned to control inputs, then optimal 
time-varying feedback gains can be determined using the techniques of modern 
control theory [18] . In a system with more than one degree of freedom, one 
has to use a feed-back matrix . This too could be conventionally obtained 
from a look-up table indexed on the configuration. 

A different system can be obtained by applying the error signals to the 
inputs to the inverse system instead (see figure 10). This has several ad- 
vantages. First, the input to the overall system from the trajectory plan- 
ner is now composed of the joint angles and the angular velocities instead 
of the angular accelerations. Secondly, this system can be analyzed more 
readily. For example, if the inverse system really is an exact inverse for 
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the dynamic system, then their cascade connection is simply an identity 
system. In this case, the overall system degenerates into an ordinary 
linear, time-invariant second-order system. The designer can now freely 
choose the response by picking the gains a and 3 - that is, the poles 
can be arbitrarily assigned. 

Noteworthy is the linearization and decoupling of degrees of free- 
dom obtained in this fashion [19]. In a system with more than one degree 
of freedom, feedback can now be applied separately to individual degrees 
of freedom, that is, a feedback matrix is not required. Furthermore, the 
feedback gains do not depend on the configuration and can be fixed. A re- 
maining analytic difficulty is the determination of the effects of small 
differences between the actual device and the dynamic model used in the 
derivation of the inverse system. 



SUMMARY AND CONCLUSIONS 

Straightforward feedback control is unable to deal correctly with 
varying effective inertias, joint torque coupling and Coriolis forces 
encountered in high-speed movements of mechanical manipulators. The pre- 
cision of manipulation for slower movement is similarly limited. Analysis 
of the dynamics of the kinematic chain leads to equations representing an 
inverse system, able to compute required joint torques from desired joint 
accelerations given the state of the device. Unfortunately this computa- 
tion is quite unwieldy and essentially useless for real time control of 
devices with more than two or three degrees of freedom. On the other hand, 
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perfonning the computation completely by look-up in a table indexed on 
the state of the device leads to a requirement for excessive amounts 
of memory. 

A compromise on this space- time trade-off is a method based on 
configuration-space look-up tables. These precomputed tables are of 
manageable size and the computations performed using the entries found 
there are relatively straightforward. Each computational cycle requires 
about n (n + 3)/2 arithmetic operations for a device with n degrees of 
freedom. The total size of the look-up table for this computation is 
less than [n (n + 1) (n + 2)/2]m n if each dimension is quantized into 
m segments. 
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1. Outline drawing of the MIT-AI-VICARM electric manipulator. This is a 
typical computer controlled device with six degrees of freedom, DC 
torque motor actuators, potentiometers for position readout and 
tachometers for the determination of angular velocities. 
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POTENTIOMETER 



TACHOMETER 



TORQUE MOTOR 



Simple one degree-of-freedom mechanical system used to illustrate 
control schemes. The control system has access to the angle of rotation 
of the shaft as well as the angular velocity and in turn controls the 
motor torque. 
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5a. Block-diagram of open-loop control using* an inverse system. 




5b. Block-diagram of modified open-loop control using actual state rather 
than predicted state in the calculation of the inverse. 
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SIDE-VIEW 




TOP-VIEW 



r^ 



Geometry of a three degree-of- freedom manipulator. This could be a 
diagram of the first three degrees of freedom of the device shown in 
figure 1, or the drawing for a "leg" on a locomotory device. 



2>CL 



7 . Table of features of the four methods for calculating actuator torque. 
The two extremes of the spectrum do not represent viable computational 
techniques because of excessive computation or storage requirement. 
Configuration space control appears to provide the optimal balance. 



J^^S 



CO 
O 
O 



co 

'0 

o 

UJ 
CD 

< 
a; 
o 

h- 
co 



CO H 

< < 

til h- 

a: id 

2 i 

/— n a 

CD 



CO 

< 
UJ 

a: 
a 



t ID 
-J U 

u. a 



z -J 

o o 

•— cc 

h* h- 

< z 

a: o 

z> u 

CD 

•-* UJ 

U O 

2 < 

O CL 

U CO 



< 
a. 

CO -J 

o 

uj or: 

< z 

h- o 

co a 



LU 
_J 
PC) 

< a. 

i 

_j *c 

-J o 

=> o 

U- -J 



W> 



• CD t 
CD ? 





J* 




•CD 


+ 






•- ■» 




• CD 


•— » 




> 


,*-»s 




CD * 




NW 




4K 


CD ? 


-^ 



— o 



o 






•CD ? 

CD i 



•CD ? 
CD ? 



W 



o 

0£ 



>- ^-. 

2 or) 

< C 

CC 

a: o 

lu cc 

> o 



+ 

CM 



+ 

c 
c 



c 

CM 



luujunaMMa ftE 



: cd ? 

•CD * 

CD i 



**" wrm-vwmivKmm 



/ ^\. 



CO 

z 
o 



< 

o 

UJ 



c 



c 

+ 

CvJ 

+ 

c 

c 



+ 

c 



CO 
LU 

-J 
>- « 
t- < 
— H- 

-J 

< Q- 
z => 

o I 

co o 
z o 

UJ -J 

•— « LL 

o o 



a: 






UJ 






CL 


UJ 

-j 




fc 


m 




fi 


< 




^-4 






u 


CL 




M 


=D 




It 


t 


>- 

a: 


UJ 


O 


h- 


o 


O 


z 


a 


-J 


UJ 



cc 

LU 

U (O Q. 

P E Q 
UJ ~. Ul 

s: h- cc 

x < ~ h- 

h- CC => Z 

*-* UJ Q? *-• 

q: cl uj o 

< o or -d 



. ?M 




<^>* 



c 




o 




•r— 




-M 




A3 




U 




13 




C7J 




•r— 




M- 




C 




o 




a 


.* 


CD 


. 


JZ 


• 


4-> 


CD 




t/> 


a> 


t. 


c 


CD 


♦r— 


> 


to 


C 


3 


•r" 


E 


CD 


CD 


-C 


4-> 


4-> 


t/) 




>> 


CD 


to 


C 




•r- 


i— 


4-> 


o 


3 


J- 


O. 


4-> 


E 


C 


O 


o 


o 


a 






s- 


a. 


o 


o 


M- 


o 




r— ■ 


-o 


| 


o 


C 


JC 


CD 


4-> 


D- 


CD 


O 


E 


C 


CD 


«tJ 


r— 




.O 


M- 


<d 


O 


+-> 


E 


Q- 


rt5 


3 


S- 


1 


O) 


J^ 


«3 


o 


•r~ 


o 


TO 


r— 


J* 


CD* 


u 


U 


o 


<T3 


r— 


Q. 


QD 


t/> 



00 



/-N. 



^""N 






CO 








CD 








I™"" 








en 






*+- 


c 






o 


fO 






CD 


4-> 


S- 




t- 


c 


CD 




fd 


•r— 


4-> 




u 


O 


^- 






•O 


(T5 




cd 








J* 


T3 


CO 




*d 


CD 


i- 




+j 


SL 


o 






•r— 


4-> 




o 


CO 


m 




4-* 


CD 


=3 






T3 


4-> 




-o 




U 




CD 


CD 


fO 




-a 


-C 






■o 


4-> 


CD 




ra 




JC 






E 


4-> 




a 


g 


O 




(0 


*t- 


4J 




JQ 








T3 


CO 


>> 




CD 


CD 






CD 


r» 


4-* 




<+- 


a> 


U 






c 


CD 




-C 


as 


S- 




4-3 




•r— 




•r— 


4-> 


"O 




2 


C 








•p. 


"O 




§ 


o 


CD 
•r- 




-M 




r— ■ 




CO 


r— 


CL 




>> 


<o 


a. 




CO 


15 
4-* 


(0 




r— • 


U 


CD 




e 


fd 






4-> 


CD 






C 


.c 


co 




o 


4-> 






o 




13 






<+- 


c 




fl3 


O 






*+- 


CO 


CO 




O 


CD 








s~ 


*- 


• 


fc= 


3 


2 


C 


<T3 


4^ 


o 


S- 


J- 


t- 




Crt 


(C 


CD 


4-i 


fC 


CL 




<o 


•r— 


CD 


CD 


a 


-o 


•o 


-C 


•r- 


1 




4-> 


<♦- 


^ 


r—" 




•r— 


u 


r— 


CD 


r— 


o 


§ 


CD 


Ql 


CO 


CO 


DC 


fO 



cr> 



2>^ 






cu 




4^ 










<+- 


e; 


>> 






'a) 


i — i 


03 


-Q 




M- 


c 




*r- 






O 


rd 


e 


S- 


T3 








e 


rd 


<1> 




<D 


4-> 


cu 


> 


C 




%- 


C 


4-> 


C 


CD 




rd 


•r— 


to 


•1— 


•r- 




u 


O 


>> 


I 


to 






•o 


to 


0) 


to 




0) 






E 


rd 




J* 


■a 


0) 


•r— 






rd 


cu 


to 


4-> 


>> 




4-> 


s~ 


s~ 




r— 






•r— 


0) 


U 


<D 




O 


to 


> 


rd 


0) 




4-> 


0) 


c 


<U 


S- 






-a 


•r— 


c 


M- 




-o 






•r 






0) 


a> 


<D 


r— 


CD 




■o 


sz 


SZ 




X3 




•o 


4-> 


4-> 


rd 






It* 








c 






E 


M- 


to 


rd 




Js^ 


o 


O 


CD 


O 




o 


s~ 




E 






rd 


<+~ 


+-> 


o 


E 




XJ 




Z5 


o 


CU 




T3 


to 


Q. 


a) 


4-> 




0) 


<u 


C 


-Q 


to 




0) 


r— • 


•r— 




>> 




<+- 


KJ) 




E 


to 






C 


'CD 


0) 






jC 


rd 


-C 


4-> 


c/> 




-P 




4-> 


to 


•r- 




•r— 


4-> 




>> 


-C 




3: 


c 


o 

4-> 


to 


4-> 




E 


o 




f— 


C 




<U 


•r-j 


"O 


r— • 


•r— 


• 


4-> 




<U 


rd 






CO 


r— • 


•r— 


s*. 


to 


ca 


>> 


rd 


r— • 


<L> 


CU 




to 


3 


CL 


> 


r— • 


■o 




4-> 


a. 


O 


o 


c 


r— 


a 


<d 




a. 


rd 


o 


rd 




<u 






t- 




to 


_C 


a> 


8 


4-> 


d) 


#r-1 


+-> 


-C 




C 


.c 






H- 


to 


o 


4-> 


(U 


#« 




c 


o 




%- 


4-* 


• 


•r— 




M- 


0) 


a 


E 


rd 


rd 


O 


JZ 


rd 

X 


0) 
4~» 


CD 


M- 


to 


r— » 


<U 


to 


<u 


O 


0) 


rd 




>> 


jC 




u 


C 


to 


to 


4-> 


E 


13 


a> 


•f— 






rd 


4-> 


• r— 




t- 


en 


U 


S- 


to 


CD 


<D 


c 


D> 


rd 




to 


-o 


•r- 


rd 


a. 


k- 


S- 


U 


4-> 


*r- 


a> 


o 


<u 


o 


<d 


"O 


T5 


J- 


> 


1 


r» 


1 




i^ 


c 


? 


3 


^ 


r» 


4i 


*pm- 


SB* 


u 
o 


£ 


01 


0) 


8 






£— 


JZ 


-C 


a> 


SB 


s 


to 


H- 


4-> 


to 


£ 



